#include "Mutex.hpp"
#include "Sem.hpp"
#include <vector>

using namespace MutexModule;
using namespace SemModule;

static const int gcap = 5;

template<class T>
class RingQueue
{
public:
    RingQueue(int cap = gcap)   
        :_cap(cap)
        ,_rq(cap)
        ,_blank_sem(cap)
        ,_data_sem(0)
        ,_p_step(0)
        ,_c_step(0)
    {}

    void Equeue(T& in)
    {
        _blank_sem.P();
        {
            LockGuard lockguard(_pmutex);
            _rq[_p_step++] = in;
            _p_step %= _cap;
        }
        _data_sem.V();
    }

    void Pop(T* out)
    {
        _data_sem.P();
        {
            LockGuard lockguard(_cmutex);
            *out = _rq[_c_step++];
            _c_step %= _cap;
        }
        _blank_sem.V();
    }

private:
    std::vector<T> _rq;
    int _cap;

    Sem _blank_sem;
    int _p_step;
    
    Sem _data_sem;
    int _c_step;
    
    Mutex _cmutex;
    Mutex _pmutex;
};